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摘 要 : 针对 果园 管理 数字 化 程度 低 、 构 建 方法 较为 单一 等 问题 ， 本 研究 提出 了 一 种 基于 激光 点 云 的 三 维 
虚拟 果园 构建 方法 。 首 先 采 用 手持 式 三 维 点 云 采 集 设 备 (3D-BOX) 结合 即时 定位 与 地 图 构建 -激光 测 距 与 
WZ (Simultaneous Localization and Mapping-Lidar Odometry and Mapping, SLAM-LOAM) 算法 获取 果园 点 云 
数据 集 ; 然后 通过 统计 滤波 算法 完成 点 云 数 据 离 群 点 与 噪声 点 的 去 除 ， 并 结合 布料 模拟 算法 (Cloth Simula- 


tion Filtering，CSF) 与 DBSCAN 
地 面 去 除 与 果树 聚 类 分 割 ， 进 而 


(Density-Based Spatial Clustering of Applications with Noise) 聚 类 算法 ， 实 现 
(EA VoxelGrid 滤波 器 降 采 样 ; 最 后 利用 Unity3D 引擎 ， 构 建 虚 拟 果 园 漫游 场 


景 ， 将 作业 机 械 的 实时 GPS (Global Positioning System) 数据 从 WGS-84 坐标 系 转换 为 高 斯 投影 平面 坐标 系 ， 
并 通过 LineRenderer 显示 实时 轨迹 ， 实 现 作业 机 械 运 动 轨迹 控制 与 作业 轨迹 的 可 视 化 展示 。 为 验证 虚拟 果园 
构建 方法 的 有 效 性 ， 在 海棠 


对 海 尝 果 树 与 芒果 树 取 类 分 
比 ， 虚 拟 芒果 加 


Re bel Sj TE AR bel FP RR 


园 构建 方法 测试 。 结 果 表 明 ， 所 提出 的 点 云 数据 处 理 方法 


U 


| 的 准确 率 分 别 达到 了 95.3% + 98.2%; HW SATE RR TB. REX) 


的 平均 行 间 误差 约 为 3.5%， 平 均 株 间 误 差 约 为 6.6%。 并 且 将 Unity3D 构建 出 的 虚拟 果园 与 


实际 果园 相 比 ， 该 方法 能 够 有 效 复 现 果 园 三 维 实际 情况 ， 得 到 了 较 好 的 可 视 化 效果 ， 为 果园 的 数字 化 建 模 


与 管理 提供 了 


种 技术 方案 。 


关键 词 : KEW 


中 图 分 类 号 : S66;TN958.98 


引用 格式 : 冯 涵 


REETA]. 智慧 农业 (9 


Eb; 点 云 处 理 ; Unity3D; 轨迹 可 视 化 ; 激光 雷达 ; SLAM-LOAM 


文献 标志 码 : A 文章 编号 : SA202207002 


, 张 浩 , EFE, 江 世 界 , 刘 伟 洪 , JFT, 王 亚 雄 , 康 峰 , 刘 星 星 , 郑 永 军 . 基于 激光 点 云 的 三 维 虚 拟 


PIX), 2022, 4(3): 12-23. 


FENG Han, ZHANG Hao, WANG Zi, JIANG Shijie, LIU Weihong, ZHOU Linghui, WANG Yaxiong, KANG Feng, 
LIU Xingxing, ZHENG Yongjun. Three-dimensional virtual orchard construction method based on laser point 
cloud[J]. Smart Agriculture, 2022, 4(3): 12-23. (in Chinese with English abstract) 


15, Ë 
在 果园 面积 、 


真实 果园 和 果树 三 维 形 态 数据 ， 而 且 可 以 结合 
Unity3D 引擎 实现 虚拟 果园 漫游 场景 以 及 果园 作 


水 果 产 量 逐 年 增长 的 趋势 下 ， 


果园 的 规范 化 、 标 准 化 管理 变 得 尤为 重要 ， 利 用 


业 机 械 工作 轨迹 的 可 视 化 ， 极 大 地 方便 工作 人 员 
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由 于 果园 地 形 的 复杂 性 和 果树 生长 的 随机 
性 ， 实 现 真实 环境 下 果园 的 三 维 模型 重建 成 为 难 
点 。 目 前 主要 采用 视觉 和 激光 雷达 (Light Detec- 
tion and Ranging, LIDAR) 进行 三 维 重 建 技术 研 
究 。 但 是 视觉 传感器 多 适用 于 单个 物体 或 者 小 型 
模型 的 构建 ， 对 于 建筑 物 集群 、 和 森林 、 果 园 等 大 
规模 的 三 维 模型 重建 存在 易 受 外 部 环境 影响 、 构 
建 误 差 大 等 缺点 “1。 激 光 雷 达 利 用 其 自身 穿 透 
性 强 、 直 线 传 播 距 离 远 和 扫描 角度 大 等 优点 ， 被 
广泛 应 用 于 文物 保护 、 建 筑 物 外 廓 提取 、 和 森林 建 
模 等 领域 ” 。 对 于 果园 这 种 大 规模 的 三 维 模型 
构建 ，Wang 等"" 采用 移动 式 激光 雷达 获取 果园 
点 去 图， 结合 轻 量 级 激光 雷达 惯性 测量 单元 
(LiDAR-IMU) 状态 估计 器 和 旋转 约束 优化 算法 
来 重建 果园 。Hu 等 … 提出 了 一 种 基于 多 站 激光 
点 云 数 据 的 树干 参数 估计 和 树干 模型 重建 方法 ， 
通过 建立 的 模型 实现 树干 几何 参数 的 准确 提取 ， 
可 用 于 和 森林 等 大 尺度 模型 的 可 视 化 和 生物 量 估 
算 。 为 了 提高 三 维 模型 的 构建 精度 ，Indirbai 
等 "基于 激光 雷达 扫描 获取 的 点 云 库 ， 结 合 分 
层 最 小 分 制 算法 和 超 体 素 聚 类 算法 ， 实 现 了 树冠 
和 树干 的 检测 以 及 单 株 植 株 的 分 制 ， 并 利用 激光 
点 云 库 重建 出 高 精度 的 树木 模型 。 姑 晓 晓 等 '3 
基于 激光 雷达 点 云 数据 ， 通 过 图 优化 的 即时 定位 
与 地 图 构建 (Simultaneous Localization and Map- 
ping, SLAM) 方法 实现 了 树木 的 三 维 重 建 。 
Zheng Fil Fu | 利用 激光 雷达 批量 优化 框架 ， 研 
究 出 了 实现 批量 优化 的 理论 导数 ， 并 将 批量 优化 
框架 融合 到 激光 测 距 与 测绘 (LiDAR Odometry 
and Mapping, LOAM) 框架 中 ， 降低 了 激光 建 
图 过 程 中 的 累计 误差 。Zhang $I Singh H 针对 不 
同时 间接 收 到 的 点 云 存 在 运动 畸变 导致 点 云 配 准 
结果 出 错 等 问题 ， 提 出 了 一 种 基于 6 自由 度 的 2 
轴 单 线 激 光 雷 达 实 时 构建 激光 里 程 计 与 建 图 的 方 
法 ， 但 是 不 具备 后 端 优化 的 功能 。 

上 述 研究 表明 ， 激 光 雷 达 可 以 有 效 获取 果园 
等 大 型 规模 特征 的 三 维 点 云 数 据 ， 但 是 对 点 云 数 
据 进 行 处 理 的 准确 性 仍 有 竺 提高， 获取 大 型 果园 


中 果树 的 数量 和 位 置 特征 描述 也 不 详细 。 本 研究 
以 海 策 果园 和 芒果 园 作为 研究 对 象 ， 提 出 了 一 种 
基于 激光 点 云 数 据 的 三 维 虚 拟 果园 构建 方法 。 采 
用 统计 滤波 算法 、 布 料 滤波 算法 (Cloth Simula- 
tion Filtering, CSF) 和 聚 类 算法 (Density-Based 
Spatial Clustering of Applications with Noise, DB- 
SCAN) 对 手持 式 三 维 点 云 采集 设备 (3D-BOX) 
获取 果园 点 云 数据 集 进 行 离散 点 去 除 、 地 面 去 除 以 
及 聚 类 分 析 ， 基 于 降 采 样 处 理 和 Unity3D 引 苟 完 成 
虚拟 果园 的 构建 ， 并 将 构建 的 果园 与 作业 机 械 二 次 
开发 ， 实 现 作业 机 械 运动 轨迹 控制 与 作业 轨迹 可 
视 化 。 


2 设备 与 方法 


2. 


一 人 


三 维 数据 采集 


本 研究 选取 两 处 地 点 作为 虚拟 果园 构建 对 
B, 一 处 是 中 国 农业 大 学 工学 院 西 侧 海 党 果园 ， 
试验 时 间 是 2021 年 3 月 1 日 ， 另 一 处 是 在 广西 省 
百色 市 田阳 县 芒果 庄园 ， 试 验 时 间 是 2021 年 4 月 
8 日 。 使 用 激光 雷达 对 这 两 处 果园 进行 扫描 完成 
三 维 点 云 的 原始 数据 采集 。 

使 用 大 连 航 佳 机 器 人 科技 有 限 公 司 的 手持 式 
三 维 点 云 采 集 设备 (3D-BOX) 进行 三 维 点 云 数 
据 采 集 ， 如 图 1 所 示 。 该 设备 分 为 数据 采集 、 客 
户 端 显示 两 部 分 。 数 据 采集 设备 是 由 Velodyne 
VLP-16 激 光 雷 达 、 惯 性 测量 单元 (Inertial Mea- 
surement Unit，IMU) 、 微 型 计算 机 组 成 ; 微型 
计算 机 连接 激光 雷达 和 IMU， 了 驱动 传 感 右 运行 ， 
采集 三 维 点 云 数 据 并 执行 建 图 ， 同 时 通过 无 线 网 
络 与 客户 端 进行 数据 交互 。 

选用 北京 雷 格 瑞 科 技 有 限 公 司 提供 的 全 球 导 
航 卫 星系 统 (Global Navigation Satellite System, 
GNSS) 定位 装置 LGR-BD982 接收 器 模块 作为 
GPS (Global Positioning System) 数据 采集 
设备 。 
2.2 点 云 预 处 理 

利用 3D-BOX 中 激光 雷达 完成 对 果园 的 三 维 


ChinaXiv 合 作 期 刊 


202302.00152v1 


chinaXiv 


ae ans 


C 
图 1 手持 式 三 维 点 云 采 集 设备 
Fig. 1 Hand-held 3D point cloud acquistion equipment 
立体 扫描 后 ， 结 合 LOAM 算法 实现 对 果园 的 三 
维 果 园 点 云 的 预 处 理 。 该 预 处 理 过 程 主 要 包括 特 
征 点 提取 、 查 找 对 应 边缘 线 与 局 部 面 片 、 激 光 雷 
达 运 动 佑 计 和 建 图 四 个 方面 ， 构 建 出 三 维 果园 原 
始点 云 模型 。 原 始 三 维 点 云 数据 模型 中 ， 由 于 激 
光 雷 达 的 精度 、 数 据 采 集 时 的 速度 和 稳定 性 以 及 
被 测 物 体 易 受 环境 因素 的 影响 ,导致 点 云 数 据 有 
大 量 噪声 点 ， 同 时 非 被 测 物体 的 遮挡 还 会 产生 一 
些 离 群 点 ， 因 此 需要 对 此 类 数据 点 进行 去 除 。 此 
外 ， 庞 大 的 点 云 数 据 对 后 续 的 可 视 化 处 理会 产生 
一 定 的 影响 ， 所 以 在 保证 果树 点 云 结构 表达 清晰 
的 情况 下 ， 对 整体 点 云 数据 集 进行 降 采 样 ， 减 少 
点 云 数量 。 在 点 云 数据 后 处 理 环 和 入， 主要 采用 去 
除 离 群 点 、 去 除 地 面 、 聚 类 以 及 点 云 降 采样 算 
法 。 本 研究 的 模型 构建 方法 流程 图 如 图 2 所 示 。 
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图 2 三 维 果 园 构 建 流程 图 
Fig. 2 Flowchart of three-dimensional orchard construction 
2.2.1 特征 点 提取 
特征 点 提取 过 程 如 下 : 通过 曲率 值 c 的 大 小 
对 特征 点 进行 分 类 ， 当 < 为 连续 数据 点 集中 的 极 
大 值 时 ， 将 该 点 设 为 边缘 点 ; 当 c 为 连续 数据 点 
集中 的 极 小 值 时 ， 将 该 点 设 为 平面 点 。 边 缘 特 征 


点 的 选取 从 最 大 曲率 < 开始 进行 ,平面 特征 点 则 
与 之 相反 。 假 设 激光 雷达 扫描 点 云 数据 集 iL] 
中 第 K 帧 点 云 数 据 为 p.，pi 中 的 茶 一 数据 点 为 i 
ie pi， 则 在 相同 扫描 帧 中 数据 点 i 邻 域 点 的 集合 
为 s， 并 定义 点 i 处 局 部 曲面 的 c 函 数 如 公式 
(1) 所 示 。 


1 

Gens tae 

[S|] Xi 

2.2.2 ”查找 对 应 边缘 线 与 局 部 面 片 

边缘 线 的 选取 方法 是 : 假设 边缘 点 ie é,, 
在 不 同 扫描 线 上 查找 i 点 的 最 近邻 点 ， 然 后 根据 
曲率 值 对 这 两 个 点 进行 判断 ， 若 是 边缘 点 ， 则 依 
据 这 两 点 确定 一 条 直线 ， 获 得 边缘 线 。 对 应 局 部 
面 片 的 选取 方法 是 : 假设 平面 点 ie A, BAI 
对 应 的 局 部 面 片 可 通过 不 共 线 的 三 个 点 确定 ， 在 
同一 扫描 线 上 选取 i 的 两 个 最 近邻 点 ， 然 后 在 不 
同 扫描 线 上 选取 一 个 对 应 i 点 的 最 近邻 点 ， 从 而 
确定 出 平面 点 ?对 应 的 局 部 面 片 ， 该 处 最 近邻 点 
的 平面 点 选取 也 要 对 其 曲率 值 进行 计算 ， 判 断 是 
和 否 为 平面 点 。 

ER 及 定义 如 下 : 假设 第 对 1 帧 扫描 起 
始 时 间 为 4._,， 扫 描 结束 时 间 为 4.， 扫 描 结束 获 
得 的 当前 帧 点 云 数据 为 p,_,;,， 利 用 空间 变换 矩阵 
将 当前 帧 点 云 数据 映射 到 时 刻 点 云 数 据 坐 标 系 
下 ， 转 换 后 的 点 云 数 据 为 p.，,， 利 用 时 刻 获取 
的 第 EK 帧 点 云 数 据 p 与 转换 后 的 点 云 数据 P| 进 
行 配 准 ， 完 成 粗略 位 姿 佑 计 ， 即 完成 4 _, 到 1 时 
刻 的 点 云 配 准 ， 从 而 完成 激光 雷达 的 位 姿 估 计 。 
在 第 K 帧 扫描 获取 的 点 云 数 据 p, 中 ， 提 边缘 点 、 
平面 点 分 别 组 成 边缘 点 集 e、 平 面 点 集 厂 ， 并 在 
Pi_1 中 查找 边缘 点 集 &1 对 应 & 的 边缘 线 以 及 平面 
Se H, XT A, ev eB A o 

所 以 本 研究 需要 判断 相 邻 两 帧 点 云 中 的 最 邻 
近 点 ,分 别 计算 边缘 点 集 &4 点 到 é& 对 应 边缘 线 和 


(1) 


> (Xiy= XE} 


jeSjei 


算 特 征 点 与 查找 到 的 对 应 边缘 线 、 局 部 面 片 的 最 
小 距离 。 计 算 方程 如 公式 (2) 和 公式 (3) 
所 示 。 
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d, = (2) 
| Bi, 1,/) Pu-l 让 
HE -pt T 
PE (£) T Ple- 1.3) 
" 7 | (3) 
Pe C: 1,5) = Pie e A (pi 1,7) - Bim) 


其 中 , AWB Ai © i 4_1 时 刻 最 近邻 
点 j ,1 e Dr_1; j, 7 确定 边缘 线 ; 4q, 为 边缘 点 i 到 
对 应 边缘 线 的 最 小 距离 ; t 时 刻 平面 点 ie HH; 
ti_ 1 时 刻 最 近邻 点 j，1，m e PL_1; dy 为 平面 点 i 
Sn Hanae 
2.2.3 激光 雷达 运动 估计 

假设 激光 雷 [2 可 时 间 段 激光 
雷达 的 位 次 变换 和 天 阵 为 到 = 
[to 5，t，0,，0,，09.]，i 为 第 次 帧 点 云 数据 pp 
中 的 任意 一 点 ， 则 [4 ,| 时 段 的 激光 雷达 位 
ZTE ,可 通过 插值 得 到 ; 点 云 数据 p, 中 的 边 毕 
点 和 平面 点 进行 坐标 转换 得 到 ， 如 公式 (4) 所 示 。 

T((k,i)) = DD)) = t)/ (t - tT 


zi = 
Xi) a 及 人 装填 Tii) (4) 
Ri (t) = ef) 

e” = I + sinb + ñ’ (1 - cosO) 


其 中 ，X ,为 边缘 点 或 平面 点 ; Xk 为 坐 
标 转换 后 相应 的 边缘 点 或 平面 的 坐标 ; RG ,为 
旋转 矩阵 ; té ) 为 平移 矩阵 ; re ñ 
H n FY BOT BR FEE 5 n PEREST E KYLEA TY, 
计算 如 公式 (5) 所 示 。 
(436) 

[réa 0| 
边缘 点 与 边缘 线 、 平 面 点 与 局 部 面 片 的 误差 
函数 如 公式 (6) 所 示 。 

S Xk Téry) = doi Ee 

ful Xai Thee) = dmi E H, (6) 

F(X in) = 4 

误差 函数 与 特征 点 是 相对 应 的 ，4d 表 示 该 
点 到 对 应 点 的 距离 ， 可 计算 了 的 雅 可 比 和 矩阵 J 


(5) 


更 新 激光 雷达 的 位 姿 7 ,。 通 过 非 线 性 的 方式 使 
dE T OOR MES (TE. )o 4 可 由 最 小 二 乘法 确定 ， 
函数 如 公式 (7) 所 示 。 

TE TE- (JTJ + Adiag(J7J)) Trad (T) 

Jip, /为 误差 函数 ; ,为 雅 可 比 矩 阵 。 
2.2.4 激光 雷达 构图 

激光 雷达 LOAM 算 法 三 维 建 图 过 程 是 在 世 
界 坐 标 系 W 下 进行 ， 且 建 图 的 频率 比 运动 估计 
的 频率 低 一 个 数量 级 。 假 设 在 激光 雷达 坐标 系 L 
F, [ts ,1] 时 间 段 转换 后 的 点 云 数 据 为 志 ， 激 
光 雷 达 位 姿 估 计 为 TA(t ,1)，t 时 刻 扫描 Kk 帧 点 云 
的 地 图 为 CO ,， 且 激光 雷达 在 该 时 刻 的 位 姿 为 
T(t), PERI AT AYE 到 ( T(t, ) FARE 
een cals ee 
转换 到 世界 坐标 系 下 为 Ò., T(t OS 
OQ; 1 对 齐 ， 并 对 激光 雷 i eh 
优化 。 


2.3 点 云 数据 后 处 理 


经 过 对 激光 点 云 的 预 处 理 过 后 ， 可 以 基本 展 
现 出 果园 树 的 模型 。 在 激光 雷 ee 
图 中 ， 包 含 了 果树 、 地 面 点 云 和 大 量 的 品 
经 过 点 云 预 处 理 后 的 点 云 数据 ， aes 
可 以 凸显 出 来 ， 但 是 大 量 的 地 面 点 云 不 仅 会 增加 
计算 量 ， 而 且 非 常 不 利于 后 续 对 点 云 地 图 的 聚 类 
分 析 处 理 。 因 此 ， 本 研究 将 对 果园 点 云 模型 进行 
后 处 理 。 
2.3.1 去 除 离 群 点 

由 于 3D-BOX 获 取 的 点 云 为 散乱 点 云 ， 采 用 
基于 点 云 库 (The Point Cloud Library, PCL) 的 
统计 滤波 器 “7” 去 除 离 群 点 。 该 方法 对 点 云集 
合 P 中 的 任意 点 p,， 查 找 离 该 点 最 近 的 个 点 
Pp Poo Poro THT RH A p, SO 
Pp Dive Di 的 欧式 距离 并 求 平 均值 ， 如 公 
式 (8) 所 示 。 


a2} 5 [(P,-P,) (8) 
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得 到 所 有 开 邻 近 点 的 平均 值 w…'ax 统 计 结 
近似 服从 高 斯 分 布 ， 所 有 点 与 上 个 邻近 点 距离 的 
均值 4 和 标准 差 cc 决定 了 其 形状 ， 记 为 
A~N(u, P), WAR (9) 和 公式 (10)。 


aj Se 
u=- >t (9) 


1 之 2 
o= Wola ~ a) (10) 


4 j=] 


(EH K RIE E S EIT EA RR 
HEES REA, WAS (11)。 

threshold = u +a X o (11) 

其 中 ，a 表 示 为 标准 差 的 倍数 。 

遍历 点 云集 合 中 所 有 点 p; 的 KK 邻近 点 距离 平 
均值 ， 将 其 分 别 与 距离 国 值 进 行 比较 ， 知 不 在 
( - threshold, + threshold) 范 围 内 ， 即 点 p, 与 
个 邻近 点 的 距离 超出 平均 距离 ， 且 大 于 a 倍 的 标 
准 差 时 ， 则 标记 为 离 群 点 ， 将 该 点 从 点 云 数据 集 
中 分 离 出 。 该 处 理 流程 如 图 3。 


统计 滤波 器 


设置 邻近 点 距离 区 


求解 标准 差 


遍历 点 云集 合 中 所 以 点 距离 


离 群 点 处 理 后 点 云 
图 3 去 除 离 群 点 流程 图 
Fig. 3 Flowchart of removing outlier 
2.3.2 ”地 面 点 云 去 除 
由 激光 雷达 扫描 获取 的 原始 数据 集 ， 点 云 数 

量 庞 大 且 杂 乱 无 章 ， 采用 CSF 算 法 ”进行 地 
面 点 云 去 除 操作 ， 保 留 非 地 面 点 云 。 其 工作 原理 
是 将 点 云 倒置 ， 通 过 布料 模拟 滤波 算法 O°", A 
定 出 布料 的 最 终 形状 ,使 其 作为 区 分 地 面 点 和 非 
地 面 点 的 基础 。 布 料 模拟 滤波 算法 是 针对 激光 点 
云 基 于 布料 模拟 的 一 种 改进 。 改 进 后 的 布料 滤波 
算法 网 格 点 位 置 和 外 部 作用 力 之 间 的 关系 表示 为 
公式 〈12)。 


X (t+ At) = 2X (t) - X(t- At) 4 = ar (12) 
其 中 ,mm 是 网 格 点 的 质量 ,通常 设 为 1; At 
为 时 间 步 长 ; GARR. 
网 格 点 的 位 移 向 量 d 计 算 方法 如 公式 (13) 
所 示 。 
=b(p,- p)en (13) 
其 中 ，Po 表 示 待 移动 网 格 点 当前 位 置 ; p, 表 
示 为 po 邻近 网 格 点 的 位 置 到 表示 为 垂直 方向 的 
单位 向 量 n = (0，0，1) ; 5 被 用 作 判 别 网 格 点 是 
否 移 动 ， 若 网 格 点 为 可 移动 点 ， 则 5 为 1， 否则 
为 0。 该 过 程 流 程 如 图 4。 


CSF 布 料 滤波 
ý 


点 云 倒置 


初始 化 布料 网 格 


Y 
为 模拟 布料 点 查找 激光 点 的 高 程 值 
ý 


设置 布料 点 为 可 移动 点 


计算 可 移动 点 位 置 与 高 程 值 一 


源 光 点 高 程 值 大 ] 


图 4 布料 滤波 算法 流程 图 
Fig. 4 Flowchart of cloth simulation filtering 
algorithm (CSF ) 


2.3.3  DBSCAN Rž +T 

DBSCAN °" 是 基于 密度 聚 类 的 经 典 算 法 之 
一 ， 可 将 点 密度 足够 大 的 区 域 分 割 成 徐 ， 并 能 在 
含有 噪声 点 的 数据 中 找到 任意 形状 的 艇 。 本 研究 
中 以 Eps 聚 类 半径 和 MinPts 核心 点 邻 域内 最 少 样 
本 数 两 个 参数 作为 区 域 划分 的 重要 前 提 ， 将 点 密 
度 高 的 区 域 划分 成 复 ， 形 成 满足 密度 相连 点 的 最 
大 集合 。 采 用 DBSCAN 算 法 对 果园 树木 进行 聚 
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FAri, RA E ERR I A cian B 
2.3.4 点 云 降 采 样 a 
将 处 理 完成 的 点 云 地 图 导入 Unity3D 引擎 进 了 
行 二 次 开发 ， 点 云 数量 过 多 将 会 增 大 项 目 开发 的 1=L-L, 
e? 


内 存 占 用 ， 因 此 还 需 对 点 云 数据 进行 降 采 样 ， 在 
保留 果园 点 云 特征 信息 最 大 化 的 条 件 下 降低 点 云 
密度 ， 减 少 文件 占用 内 存 。 本 研究 基于 体 素 滤波 
方法 对 PCL 点 云 库 聚 类 后 的 点 云 数 据 进行 降 采 样 
处 理 。 


2.4 虚拟 果园 设计 


果园 漫游 场景 将 通过 虚拟 的 方式 显示 实际 果 
园 情 况 ， 以 果园 点 云 地 图 为 基础 ， 在 Unity3D 引 
擎 3 中 进行 二 次 开发 ， 对 果园 点 云 模型 进行 处 
理 ， 开 发 三 维 虚拟 果园 。 主 要 包含 场景 漫游 、 轨 
迹 显 示 、 坐 标 交 互 以 及 文件 管理 等 功能 。 构 建 虚 
拟 果 园 所 使 用 到 的 软件 包括 点 去 数据 处 理 库 
PCL, Unity3D 开发 引擎 、 点 云 文件 格式 转换 工 
具 MeshLab、 作 业 机 械 喷 雾 机 模型 处 理工 具 
3DMax 以 及 脚本 语言 C# 等 。 

2.4.1 GPS 数 据 处 理 

(1) 经 纬度 提取 。 该 功能 采用 C# 中 的 
StreamReader 类 在 文件 流 中 实现 原始 数据 逐 行 读 
取 。 本 人 研究 在 读 取 一 行 数 据 时 采用 两 种 数据 提取 
的 方式 ， 一 种 是 按 特殊 字符 进行 查询 ， 再 对 字符 
串 进行 截取 ; 另 一 种 是 根据 目标 对 象 在 字符 串 中 
所 处 的 位 置 进行 查询 ， 对 指定 位 置 的 字符 串 进行 
截取 。 截 取 后 的 经 纬度 字符 串 转 换 为 双 浮 点 型 。 
为 方便 查询 ,将 转换 为 双 浮 点 型 的 经 纬度 数据 先 
存 人 二 维 数组 ， 再 添加 到 词典 临时 存储 。 

(2) 坐标 转换 。GPS 数据 采集 设备 获取 的 数 
据 属 于 WGS-84 大 地 坐标 ， 是 包含 了 经 纬度 和 海 
拔高 度 的 一 种 球面 坐标 。 本 人 研究 将 在 二 维 平面 进 
行 轨迹 绘制 ， 故 需 对 球面 坐标 进行 处 理 ， 将 大 地 
坐标 进行 高 斯 投影 坐标 换算 ， 转 换 为 高 斯 投影 平 
面 坐 标 。 坐 标 求解 如 公式 〈14) 和 公式 (15) 所 示 。 


x=X+ 5 Noos* 0B + Ax 


Ñ (14) 
y = NeosBl + ges BUI -Ê +p )P + Ay 


2 一 


- cos? B 
l-e 


yi 

其 中 ， 所 有 经 度 纬度 都 是 换算 为 弧度 的 经 度 
纬度 ，(°); X 对 应 纬度 的 子午 线 弧 长 ; B 为 坐标 
点 的 纬度 ，N 为 卯 西 圈 半 径 ; a 为 长 半 轴 ; eJ 
球 第 一 偏心 率 ; 工 为 点 的 经 度 ，(?); Z 为 中 央 子 
午 线 的 经 度 ，(°)。 

本 研究 在 WGS-84 坐标 系 向 高 斯 投影 坐标 系 
转换 处 理 中 采用 3° 分 带 ， 经 坐标 转换 后 获得 的 y 
值 前 两 位 数字 为 代号 ， 同 时 防止 y 值 为 负 ， 在 y 
值 的 结果 上 加 500 km 处 理 ， 即 整体 对 y 值 进行 了 
相同 距离 的 平移 ， 因 此 对 轨迹 显示 并 无 影响 。 
2.4.2 ”漫游 场景 设计 

以 重建 的 三 维 虚 拟 果 园 为 基础 ， 将 作业 机 械 
加 载 到 虚拟 果园 环境 中 ， 进 而 模拟 果园 作业 机 械 
工作 情况 。 通 过 作业 机 械 实 现 真 实 世 界 与 虚拟 世 
界 的 映射 ， 建 立 作业 机 械 工作 轨迹 绘制 与 作业 过 
程 模 拟 等 功能 。 在 虚拟 果园 环境 中 ， 添 加 平移 、 
旋转 和 缩放 等 必要 的 查看 功能 ， 并 在 显示 界面 右 
上 方 地 点 显示 栏 接 入 了 百度 地 图 普通 定位 应 用 程 
序 接口 API (Application Programming Interface ) 
和 系统 时 间 ， 实 现 果 园 漫游 场景 的 实时 呈现 。 在 
虚拟 果园 的 其 他 功能 中 添加 了 测量 工具 、 时 间 地 
点 显示 以 及 历史 数据 保存 等 ， 建 立 了 一 个 比较 完 
善 果园 作业 机 械 显示 场景 。 基 于 Unity3D 开发 平 
台 使 用 System.IO.Ports 类 设计 了 GPS 数据 采集 交 
AFM, AA SAE GPS 串口 数据 、 存 储 数 
据 、 经 纬度 提取 、 坐 标 转换 处 理 。 

Unity3D 能 够 进行 层级 式 开发 环境 、 可 视 化 
编辑 环境 等 操作 ， 并 且 可 使 用 Direct3D、 
OpenGL, APIs 等 图 形 引 擎 和 PhysX 物理 引擎 ， 
完成 开发 调试 功能 ， 开 发 人 员 在 开发 过 程 中 可 随 
时 查看 三 维 虚拟 果园 漫游 状况 。 

将 点 云 进行 纹理 化 处 理 主要 在 Unity3D 中 实 
现 ， 主 要 过 程 如 下 : 将 目标 点 云 信息 与 图 像 纹 理 
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信息 进行 匹配 ， 得 到 具有 真实 颜色 信息 的 点 云 模 
型 ;着色 后 的 点 云 可 以 直接 生成 密集 的 三 角 网 模 
型 ， 对 三 角 网 模型 进行 泻 染 时 进行 RGB 颜色 匹 
配 ， 得 到 具有 真实 颜色 的 三 角 网 模型 ， 对 于 较 稀 
BAY =A A, ， 进 行 纠 正 与 纹理 映射 ， 最 后 得 
到 具有 纹理 真实 感 的 三 维 果园 模型 。 
2.4.3 轨迹 可 视 化 

GPS 数据 采集 设备 采集 的 GPS 数据 处 理 是 轨 
迹 绘制 的 关键 环节 ， 处 理 的 结果 将 直接 影响 后 续 
的 轨迹 可 视 化 。 采 集 的 GPS 数据 转换 为 高 斯 投影 
平面 坐标 数据 后 ， 使 用 该 数据 基于 Unity3D 平台 
实现 轨迹 的 可 视 化 。 将 果园 点 云 模型 导入 Uni- 
ty3D 坐标 原点 位 置 为 质心 位 置 ， 绘 制 轨迹 过 程 将 
以 质心 位 置 为 起 始点 ， 经 度数 据 沿 Z 轴 方向 ， 纬 
度数 据 沿 广 轴 方向 进行 绘制 ; 在 实际 采集 GPS 数 
据 时 ， 固 定 了 采集 的 起 始 位 置 ， 因 此 在 绘制 轨迹 
时 要 先 计算 出 质心 坐标 与 固定 起 点 两 者 之 间 的 偏 
移 量 ， 然 后 读 取 平面 坐标 数据 进行 绘制 。 轨 迹 绘 
制 部 分 依赖 于 Unity3D 中 的 LineRenderer 2X jet 4t 
器 ， 可 对 线 的 材质 、 颜 色 、 宽 度 等 属性 进行 设 
置 。 本 研究 采用 默认 材质 和 颜色 ， 宽 度 设置 为 
0.05 m， 并 设置 绘制 轨迹 坐标 系 为 世界 坐标 系 。 


3 结果 分 析 与 功能 验证 
利用 3D-BOX 扫描 获取 的 海 策 果园 与 芒果 园 
全 局 点 云 数 据 ， 点 云 数据 采集 完成 后 ， 安 装 GPS 


数据 采集 设备 于 作业 机 械 上 ， 在 该 区 域 运 行 采集 
轨迹 数据 。 图 5 为 芒果 园 实 景 图 。 


(a) 行 间 实景 (b) 总 体 实景 
图 5 芒果 园 实 景 图 


Fig. 5 View of mango orchard 


3.1 算法 验证 结果 分 析 


3.1.1 点 云 预 处 理 

将 激光 雷达 三 维 扫描 的 海 党 果园 与 芒果 园 原 
始点 云 数 据 进 行 特 征 点 提取 、 查 找 对 应 边缘 线 与 
局 部 面 片 、 激 光 雷 达 运 动 估计 和 建 图 等 初步 预 处 
理 操作 后 ， 得 到 预 处 理 后 果园 点 云 数 据 集 。 原 始 
果园 点 云 与 预 处 理 后 点 云 如 图 6 所 示 。 


(a) 原 始 海 党 果园 点 云 数 据 集 


(b) 预 处 理 后 海棠 果园 点 云 数 据 集 


(c) 原 始 芒果 园 点 云 数 据 集 


(d) 预 处 理 后 芒果 园 点 云 数据 集 


图 6 点 云 预 处 理 前 后 效果 对 比 图 


Fig. 6 Comparison of the effects before and after the point 


cloud pretreatment 


3.1.2 ”点 云 后 处 理 

(1) 统计 滤波 去 除 离 群 点 。 在 Ubuntu 系统 
下 基于 PCL 点 云 库 进行 统计 滤波 对 预 处 理 后 的 果 
园 点 云 数 据 集 进行 去 除 离 群 点 。 设 置 K 邻 近 搜 索 
点 数 阔 值 z 为 40， 标 准 差 c 的 倍数 a 为 0.6， 此 处 
两 个 数值 7 和 a 的 设置 为 经 验 值 。 在 海 党 果园 数 
据 处 理 过 程 中 ， 去 除 离 群 点 滤波 前 该 数据 集 共 有 
4,746,821 个 点 ， 滤 波 之 后 数据 集 为 4,113,008 个 
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点 。 在 芒果 园 数 据 处 理 过 程 中 ， 波 波 前 该 数 
据 集 共有 4,303,845 个 点 ， 滤 波 之 后 数据 集 共 有 
3,548,440 个 点 ， 芒 果园 果树 的 轮廓 已 经 凸显 ， 但 
仍 存在 少量 杂 点 。 由 于 实际 环境 杂 草 较 多 且 高 度 
不 一 ， 导 致 激光 雷达 扫描 的 地 面 点 云 数据 较为 稀 
琉 ， 使 用 统计 滤波 去 除了 部 分 地 面 点 云 ， 效 果 如 
图 7 所 示 ， 同 时 验证 了 该 阔 值 参数 下 的 统计 滤波 
可 用 于 其 他 场景 。 


(a) 海 党 果园 统计 滤波 去 除 离 群 点 效果 图 


(b) 芒 果园 统计 滤波 去 除 离 群 点 效果 图 
图 7 统计 滤波 后 点 云 效果 图 


Fig. 7 Point cloud effect after statistical filtering 


(2) CSF 地 面 去 除 。 采 用 CSF 算法 对 PCL 点 


云 库 进 行 地 面 点 云 数据 去 除 操作 ， 海 演 果 园 去 除 
效果 如 图 8 (a) 所 示 ， 绿 色 为 果树 点 云 ， 红 色 为 
地 面 点 云 。 芒 果园 试验 环境 坡度 相对 较 大 ， 滤 波 
后 地 面 点 云 兢 玖 ， 去 除 效 果 如 图 8 (b) 所 示 。 在 
对 地 面 点 云 数据 进行 去 除 后 ， 过 滤 后 的 树冠 点 云 
特征 变化 不 明显 。 


(a) 海 棠 果园 CSF 去 除 地 面 点 云 效果 图 


(b) 芒 果园 CSF 去 除 地 面 点 云 效果 图 
图 8 CSE 去 除 地 面 点 云 效果 图 


Fig. 8 Results of ground point cloud removal using CSF 


园 与 芝 果 园 树林 树木 ， 进 行 聚 类 分 析 如 下 : 设置 
聚 类 半径 Eps 为 1， 密 度 阔 值 MinPts 为 100; 海 
党 果园 树木 为 43 棵 ， 其 中 两 棵 非 同 一 品种 且 树 
高 不 同 。 经 聚 类 同样 可 得 到 的 43 个 艇 。 统 计 实 
际 环境 芒果 树 共 有 57 棵 树 ; 经 聚 类 得 到 56 个 簇 ， 
使 用 正 检 率 与 准确 率 来 对 果园 激光 点 云 进 行 聚 类 
分 割 进度 分 析 ， 正 检 率 (A) 和 准确 率 (R) 可 
由 公式 (16) 得 出 : 


A= x 100% 
a (16) 
= 7 x 100% 
其 中 ，z 为 正确 分 制 的 树木 数量 ， 棵 ; N 为 分 制 
得 到 的 树木 数量 ， 棵 ; M 为 人 工 计 数 的 实际 树木 数 


(3) 聚 类 分 析 。 通 过 分 别 统计 实际 该 海 策 果 


量 。 果 网 DBSCAN 限 类 准确 率 结果 如 表 1 所 示 。 


表 1 果园 DBSCAN 聚 类 准确 率 
Tablel Orchard DBSCAN clustering accuracy 


果园 种 类 实际 树木 数量 / 棵 分割 得 到 树木 数量 / 棵 ”正确 分 割 树木 数量 / 棵 IER% 准确 率 /% 
芒果 果园 43 43 41 100 95.3 
海 觉 果园 57 56 56 98.2 98.2 


在 海 党 果园 中 ， 由 于 树林 株 间 、 行 间 树 木 均 
存在 郁 闭 状况 ， 因 此 DBSCAN 聚 类 并 没有 完全 
将 一 整 棵 树 聚 类 ， 准 确 率 只 有 95.3%， 但 聚 类 结 
果 与 实际 树林 统计 棵 树 一 致 。 对 于 芒果 园 ， 树 林 


全 将 每 棵 树 聚 类 ， 正 检 率 和 准确 率 为 98.2%， 聚 
类 分 割 效 果 还 有 待 提 高 。 聚 类 效果 如 图 9 所 示 。 

(4) 降 采 样 处 理 。 在 保证 树木 点 云 特征 基本 
一 致 的 情况 下 ， 采 取 了 降 采 样 处 理 ， 体 素 尺 寸 设 


株 间 、 行 间 树木 也 均 存 在 郁 闭 状况 ， 且 株 间 芳 
树 郁 闭 较为 严重 ， 因 此 DBSCAN 聚 类 并 没有 完 


y 


置 0.05X0.05X0.05， 降 采样 前 海 常 果园 点 云 数 
目 为 2,316,788 个 ， 降 采样 后 为 610,076 个 。 芒 果 
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(b) 芒 果园 DBSCAN 聚 类 

图 9 果园 DBSCAN 聚 类 效果 图 
Fig.9 Results of orchard DBSCAN clustering 
园 隆 采样 前 点 去 数目 为 2,216,632 个 ， 降 采样 后 
为 855,130 个 ， 进 而 建立 出 降 采 样 处 理 效果 图 。 
将 降 采 样 处 理 前 和 人 处理 后 的 点 云 数据 合并 展示 ， 
红色 点 为 降 采 样 处 理 前 的 数据 点 ， 绿 色 点 为 降 采 
样 处 理 后 的 数据 点 。 降 采样 后 效果 图 如 图 10 
所 示 。 


(a) 海 党 果园 降 和 采样 处 理 前 后 数据 合并 显示 效果 


(b) 芒 果园 降 采 样 处 理 前 后 数据 合并 显示 效果 


图 10 降 采 样 处 理 前 后 数据 合并 显示 效果 图 
Fig. 10 Merge display of before and after data downsampling 


(5) 精确 度 检测 。 因 果园 地 面 有 一 定 坡 度 且 
地 面 不 平整 ， 地 面 杂 草 较 多 ， 重 建 后 的 果园 在 去 
除 地 面 点 云 后 果树 高 度 会 存在 误差 ， 所 以 本 研究 
主要 通过 测量 果树 的 株距 和 行距 来 检测 重建 精确 
度 ， 如 图 11 所 示 。 由 于 海 策 果园 中 夹杂 着 两 颗 
非 同一 品种 的 树 ， 所 以 在 测量 位 置 时 会 存在 较 大 
的 误差 。 本 研究 在 芒果 园 的 实际 环境 中 ， 选 取 4 
处 位 置 进行 测量 ， 这 4 处 位 置 分 别 是 扫 朱 第 一 行 


果树 的 起 始 位 置 、 中 间 人 位置、 第 一 行 末 尾 位 置 以 
及 扫描 结束 位 置 ， 测 量 数据 如 图 12 所 示 ， 两 者 
进行 比较 。 结 果 表 明 ， 平 均 行 间 误 差 约 为 3.5%， 
平均 株 间 误差 约 为 6.6%， 因 株 间 果树 郁 闭 严重 ， 
误差 较 大 ， 最 大 误差 处 于 10% 左 右 。 通 过 比较 实 
际 芒 果树 与 建 模 后 株距 和 行距 精确 度 ， 如 图 13 
所 示 ， 株距 精确 度 大 于 88.8%, 行距 的 精确 度 大 
于 93.6%。 


(a) 有 果树 行距 测量 (b) 果 树 株距 测量 
图 11 芒果 树 行距 、 株 距 实 际 测量 
Fig. 11 Mango tree row spacing and plant spacing actual 


measurement 


图 12 芒果 树 点 云 行 距 、 株 距 扫 描 测量 结 果 


Fig. 12 Scan results of mango tree point cloud spacing and 


plant spacing 


3.1.3 三 维 果 园 构建 效率 

本 研究 果园 三 维 模型 重建 工作 环境 CPU 为 
i7-9750H, 8 G 运行 内 存 ，Ubuntu18.04 系 统 下 进 
行 编译 运行 。 三 维 果 园 建 园 过 程 中 会 产生 大 量 的 
点 云 ， 算 法 的 运行 效率 会 随 着 点 云 的 数量 增加 而 
逐渐 降低 。 点 云 预 处 理 过 程 中 主要 采用 激光 雷达 
结合 LOAM 算法， 所 消耗 的 时 间 较 短 。 因 此 本 
研究 重点 比较 海 党 果园 与 芒果 园 在 后 处 理 过 程 中 
点 云 数 量 以 及 其 运行 时 间 ， 如 表 2 所 示 。 通 过 累 
计 上 述 三 个 时 间 段 的 时 长 ， 海 党 果园 的 点 云 后 处 
理 与 芒果 园 的 点 去 后 处 理 时 间 都 在 30s 内 ， 具 有 
较 高 的 处 理 效 率 。 


3.2 虚拟 果园 系统 功能 测试 验证 


为 验证 虚拟 果园 系统 所 具备 的 功能 有 效 运 
行 ， 本 研究 在 广西 省 百色 市 田阳 县 芒果 庄园 和 中 
国 农业 大 学 海 演 果园 进行 了 测试 。 主 要 对 果园 场 
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中 间 位 置 ”第 一 行 末尾 位 置 扫描 结束 位 置 
果园 位 置信 息 


(a) 实 际 芒果 树 与 建 模 后 株距 精确 度 


起 始 位 置 


CO 实际 果园 行距 
E 建 模 后 果园 行距 


400 F 


精度 /% 


100 上 


起 始 位 置 中 间 位 置 第 一 行 末尾 位 置 ”扫描 结束 位 置 
果园 位 置信 息 


(b) 实 际 芒果 树 与 建 模 后 行距 精确 度 


图 13 芒果 园 构 建 精确 度 
Fig. 13 Construction accuracy of mango orchard 

景 漫游 以 及 果园 作业 机 械 运 行 轨迹 可 视 场 景 进行 
验证 。 通 过 登录 界面 进入 三 维 虚拟 果园 系统 主 界 
面 ， 在 系统 主 界面 根据 用 户 需 求 选择 功能 场景 ， 
点 击 对 应 按钮 可 进入 相应 场景 。 点 击 选 择 轨迹 文 
件 按钮 后 即 可 绘制 轨迹 ， 该 处 轨迹 文件 数据 是 经 
过 转换 的 高 斯 投影 平面 坐标 数据 。 通 过 对 虚拟 果 
园 系 统 所 涉及 的 功能 进行 测试 以 及 系统 所 具备 的 
功能 进行 展示 ， 如 图 14 所 示 ， 海 策 果 园 和 芒果 
园 作业 机 械 与 作业 轨迹 可 视 化 效果 较 好 。 测 试 结 
果 表 明 ， 虚 拟 果园 系统 的 各 功能 均 能 恨 好 运行 。 


Sine et ot 
(b) 海 党 果园 作业 机 械 运动 轨迹 


(d) 芒 果园 作业 机 械 行驶 过 程 模拟 测试 图 


图 14 虚拟 果园 功能 测试 结果 
Fig. 14 Functional test results of virtual orchards 


4 结 论 


本 研究 提出 了 一 种 基于 激光 雷达 的 三 维 虚拟 
果园 构建 方法 ， 并 通过 海 党 果园 和 芒果 园 对 方法 
进行 验证 。 主 要 结论 如 下 : 

(1) 构建 的 果园 模型 具有 较 高 的 准确 性 。 本 
文选 取 实际 环境 下 的 芒果 园 果 树 行距 、 株 距 进 行 


表 2 不 同 算法 运行 时 间 表 
Table 2 Run schedule of the algorithms 


点 云 数 据 点 云 处 理 过 程 预 处 理 后 点 云 统计 滤波 CSF 布料 滤波 降 采样 
、 点 云 数 量 /个 4,746,821 4,113,008 2,316,788 670,076 
海棠 果园 
运行 时 间 /s 约 5 22.4 1.2 0.5 
i 点 云 数 量 /个 4,303,845 3,548,440 2,216,632 855,130 
芷 果园 See 
运行 时 间 /s 约 5 20.9 1.1 0.5 
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测量 ， 与 重建 后 的 结果 进行 对 比 ， 平 均 行 间 误差 
约 为 3.3%， 平 均 株 间 误 差 约 为 6.6%。 

(2) 所 提出 的 方法 具有 普 适 性 。 本 研究 采用 
DBSCAN 算法 分 别 对 海 党 果园 和 芒果 园 进 行 聚 
类 分 析 ， 对 海 策 果 园 与 艺 果 园 聚 类 准确 率 分 别 达 
到 了 95.3% 和 98.2%; 并 且 两 种 果园 的 点 云 后 处 
理 过 程 时 间 均 在 30s 内 。 

(3) 基于 Unity3D 引擎 开发 三 维 虚 拟 果 园 ， 
所 添加 的 各 项 功能 够 流畅 运行 。 通 过 对 虚拟 果园 
系统 所 具备 的 功能 进行 测试 ， 本 研究 构建 的 三 维 
虚拟 果园 能 够 满足 作业 机 械 轨迹 绘制 ， 并 可 进行 
历史 作业 过 程 的 模拟 ; 有 具备 果园 场景 的 全 方位 立 
体 显示 、 距 离 测 量 、 位 置 显示 等 功能 。 

(4) 本 研究 的 DBSCAN RAHE, ÆRE 
郁 闭 严 重 的 情况 下 聚 类 分 制 效 果 有 竺 改进; 后续 
可 以 优化 聚 类 分 割 算 法 ,提升 分 割 精度 ， 并 将 聚 
类 分 割 作 为 虚拟 果园 的 一 项 功能 ， 实 现在 虚拟 果 
园 中 的 聚 类 分 析 。 
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Abstract: To solve the problems of low level of digitalization of orchard management and relatively single construction method, 
a three-dimensional virtual orchard construction method based on laser point cloud was proposed in this research. First, the 
hand-held 3D point cloud acquistion equipment (3D-BOX) combined with the lidar odometry and mapping (SLAM-LOAM) al- 
gorithm was used to complete the acquisition of the point cloud data set of orchard; then the outliers and noise points of the 
point cloud data were removed by using the statistical filtering algorithm, which was based on the K-neighbor distance statisti- 
cal method. To achieve this, a distance threshold model for removing noise points was established. When a discrete point ex- 
ceeded, it would be marked as an outlier, and the point was separated from the point cloud dataset to achieve the effect of dis- 
crete point filtering. The VoxelGrid filter was used for down sampling, the cloth simulation filtering (CSF) cloth simulation al- 
gorithm was used to calculate the distance between the cloth grid points and the corresponding laser point cloud, and the distinc- 
tion between ground points and non-ground points was achieved by dividing the distance threshold, and when combined with 
the density-based spatial clustering of applications with noise (DBSCAN) clustering algorithm, ground removal and cluster seg- 
mentation of orchard were realized; finally, the Unity3D engine was used to build a virtual orchard roaming scene, and convert 
the real-time GPS data of the operating equipment from the WGS-84 coordinate system to the Gauss projection plane coordi- 
nate system through Gaussian projection forward calculation. The real-time trajectory of the equipment was displayed through 
the LineRenderer, which realized the visual display of the motion trajectory control and operation trajectory of the working ma- 
chine. In order to verify the effectiveness of the virtual orchard construction method, the test of orchard construction method 
was carried out in the Begonia fruit and the mango orchard. The results showed that the proposed point cloud data processing 
method could achieve the accuracy of cluster segmentation of Begonia fruit trees and mango trees 95.3% and 98.2%, respective- 
ly. Compared with the row spacing and plant spacing of fruit trees in the actual mango orchard, the average inter-row error of 
the virtual mango orchard was about 3.5%, and the average inter-plant error was about 6.6%. And compared the virtual orchard 
constructed by Unity3D with the actual orchard, the proposed method can effectively reproduce the actual three-dimensional sit- 
uation of the orchard, and obtain a better visualization effect, which provides a technical solution for the digital modeling and 
management of the orchard. 


Key words: virtual orchards; point cloud processing; Unity3D; trajectory visualization; LIDAR; SLAM-LOAM 
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